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Abstract 

Apparatus and method for determining the azimuth (heading), pitch and roll which include a 
magnetometer-type sensor providing Hx, Hy and Hz related signals, and coil elements wound around 
the magnetometer which selectively impose specific magnetic fields about the sensor. The Hx, Hy and 
Hz field components of the magnetic field are measured from the sensor with and without the selective 
energization of the magnetic coils and stored, from which the azimuth, pitch and roll are calculated. 
Furthermore, quadrant correction is applied such that a unique reading is produced for all angles 
through 360 DEG of azimuth, pitch or roll. 
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Die Erfmdung bezieht sich auf ein Verfahren zur Besting von 
Azimut und Neigung relativ zu einem Meflrahnen mit ersten zwei- 
ten und dritten zueinander orthogonalen Achsen einer Struktur 
die emen darauf kardanisch aufgehangten KompaB enthalt. 

Bei Kcnpassen, die Magnetometer mit zwei orthogonal gerichteten 
induktiven MeBsondenelementen umfassen, die Signale liefern, aus 
denen ein Kurs bzw. Steuerkurs berechnet wird, sind auch Neigung 
und Rollen des Schiffes oder einer Plattform, an der der KompaB 
befestigt ist, per se von Interesse, und weil es moglicherweise 
die Kursberechnungen beeinfluBt. Demzufolge sind Neigungs- und 
Rollsignale genauso erwunscht wie Kurssignale. Jedoch sind sepa- 
rat abgeleitete Signale nicht so gut, wie tatsachlich die Nei- 
gung und Rollen der kardanisch aufgehangten Plattform zu messen. 

Deshalb wird. er f indungsgemaB der Kurs durch folgende Schritte 
berechnet: Messen des Umgebungsmagnetf eldes in Form dreier im 

, wesentlichen unabhangiger Komponenten und Liefern bzw. Erzeugen 
von Feldkomponentensignalen Xe, Ye und Ze, jeweils in Richtung 
der zueinander orthogonalen X-, Y- und Z-Achsen in einem durch 
den Kompa/3 definierten MeBrahmen (Block 106); Anlegen eines er- 
sten - zur Y-Achse des MeBrahmens orthogonalen - vorgegebenen 
Magnetfeldes (Block 112); Messen der unabhangigen Komponenten 
des Magnetf eldes, die aus der Uberlagerung des Umgebungsmagnet- 
feldes und des ersten vorgegebenen Magnetfeldes resultieren und 
Erzeugen von Feldkomponentensignalen Xp, Yp und Zp (Block 114) • 

-Bestimmen des Azimuts (e) entsprechend dem Arkustangens von 
(Ve/Xe) (Block 130); Bestimmen des Pollens (P) entsprechend dem 
Arkustangens von [ (x P -Xe) / ( z P -Ze) ] (Block lis , 120) ; und Uber- 
traen von Signalen, die 6 und P darstellen (Block 134). 

Die Erfindung wird besser verstanden beim Lesen der folgenden 
detailxerten Beschreibung im Zusammenhang mit der Zeichnung 
wobei : • ^ / 
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Fig. 1 eine Blockzeichnung eines erf indungsgemafien Ausfuh- 

rungsbeispiels ist; 
Fig. 1A eine Querschnittansicht der Neigungs- und Rollspulen 

ist, die den Sensor umgeben; und 
Fig. 2 ein Flufldiagramm des Verfahrens zur Berechnung von 

Azimut, Neigung und Rollen gemafi einem erf indungsgema- 

Ben Ausf iihrungsbeispiel ist. 

In Fig. 1 wird eine Blockzeichnung eines Ausf iihrungsbeispiels 
des Systems 50 gezeigt, wobei ein Sensor 52, der drei orthogona- 
le Magnetf eldfuhler 52A, 52B und 52C enthalt, typischerweise 
induktive Meftsonden, in einer Struktur gehalten wird, die eine 
Neigungsspule 54 und eine daruber angeordnete Rollspule 56 auf- 
weist, urn ein vorgegebenens Gleich ( strom) magnetf eld selektiv fur 
den nachfolgend beschr iebenen Verfahren zu liefern. Die speziel- 
len Proportioned der Neigungs- t und Rollspulen 52 und 54 sind 
deutlicher in Fig. 1A dargestellt, wobei die Spulen 52 und 54 
solenoidf ormig gewundene Spulen umfassen, die sich uber den 
Sensor 52 derart ausdehnen, daB die durch die entsprechenden 
Spulen erzeugten FluBlinien im wesent 1 ichen parallel und gleich- 
formig durch den Sensor 52 laufen. Die drei orthogonalen Magnet- 
feldfiihler 52A, 52B und 52C des Sensors 52 definieren einen Me/3- 
rahmen fur die Bestimmung des Rollens uber die Y-Achse und der 
Neigung uber die X-Achse. 

Die von den individuel len MeBsonden im Sensor 52 erhaltenen 
Signale werden von den Elementen 60, 62 und 64 gemessen und von 
einem Prozessor 66 empfangen und gespeichert. Der Prozessor 
versorgt bzw. aktiviert sequentiell und selektiv die Neigungs- 
und Rollspulen 54 und 56 entsprechend den Steuersignalen, die 
jeweils an den Versorgungsschaltkreisen 68 und 70 anliegen. Die 
berechneten result ierenden Neigung, Rollen und Azimut werden an 
Ausgangsleitungen 72 zur Verfiigung gestellt und/oder selektiv an 
einem Display 74 angezeigt. 

Das erf indungsgemaJ3e Ausf iihrungsbeispiel 50 enthalt einen Pro- 
zessor 66, der typischerweise einen Mikroprozessor umfafit, z. B. 


den MCS 48 Series Microprocessor, hergestellt von Intel Corp., 
den 6800 Series Microprocessor, hergestellt von Motorola inc., 
Oder damit vergleichbare , und der erf irtdungsgemaB von einem 
Fachmann entsprechend dem nachf olgenden Verfahren programmiert 


ist 


Das erfindungsgemaBe Verfahren liefert ein periodisches "Up- 
date" der Neigungs-, Roll- und Azimutsignale . Ein Ausfiihrungs- 
beispiel des Verfahrens ist im FluBdiagramm 100 in Fig. 2 darge- 
stellt, wobei das Verfahren mit dem Schritt 102 beginnt und die 
Spulen im Schritt 104 abschaltet, so daB die X-, Y- und Z-Signa- 
le, die durch den Sensor 52 geliefert und durch die Elemente 60, 
62 und 64 gemessen und als Xe , Ye und Ze auf gezeichnet werden, 
nur dem Umgebungsmagnetf eld (der Erde) Hx, , Hy, und Hz, entspre- 
chen. Die Messung wird im Schritt 106 durchgef iihrt . Sodann wird 
im Schritt 108 die Rollspule 56 aktiviert und die drei orthogo- 
nalen Signale werden im Schritt 110 fur die Feldkomponenten Hx 2/ 
Hy 2 und Hz 2 gemessen, wobei die Signale als Xr, Yr und Zr auf ge- 
zeichnet werden. Sodann wird die Rollspule 56 deaktiviert und 
die Neigungsspule 54 im Schritt 112 aktiviert. Die Signale des 
Sensors werden im Schritt 114 gemessen und liefern die Xp-, Yp- 
und Zp-Signale, die Hx„ Hy, una Hz 3 entsprechen, die das Umge- 
bungserdmagnetfeld und das durch die Neigungsspule angelegte 
Feld umfassen. Vorzugsweise werden die obigen Schritte der Mes- 
sung des Sensorsignals mit und ohne Aktivierung der einzelnen 
Roll- und Neigungsspulen in einem kurzen Intervall durchgef uhrt, 
z.B. 15 Millisekunden, urn einen "Schnappschu/3" der Umgebungs- 
feldbedingungen zu liefern. Falls zwischen den Lesevorgangen 
eine verlangerte Zeitperiode existiert, so daB die Plattform, an 
welche der KompaB befestigt ist, ihre relative Position veran- 
dert, bewirken Anderungen in den Umgebungsf eldbedingungen feh- 
lerhafte Berechnungen der erwunschten Signale. 

Die bei Abschaltung aller Spulen gewonnenen Signale (Xe, Ye und 
Ze) werden von den bei aktivierter Rollspule gewonnenen Signalen 
(Xr, Yr und Zr) subtrahiert, so daB im Schritt 116 die Diffe- 
renzsignale XI, YI und ZI resultieren. Ahnlich werden die bei 
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deaktivierten Spulen gemessenen Signale in Schritt 118 von den 
bei aktivierter Neiguhgsspule gewonnenen Signalen (Xp, Yp und 
Zp) subtrahiert, was die Signale XII, YII und ZII liefert. 

Im Schritt 120 wird die Neigung (P) berechnet, entsprechend dem 
Arkustangens XII/ZII (Arkustangens (Hx 2 - Hx,)/(Hz 2 - Hz,)). Im 
Schritt 12 2 wird eine Quadrant-Korrektur angewendet, derart, da£ 
- falls der Wert von XII (Hx-Signal) kleiner ist als 0 - 180° 
zum Wert der Neigung addiert wird und - falls der Wert von XII 
(Hx) grower als 0 ist und der Wert von ZII (Hy) kleiner als 0 
ist - ein Wert von 3 60° zum berechneten Wert der Neiguhg addiert 
wird. Sodann wird im Schritt 124 der Wert von ZI mit 1 + sin P 
multipliziert , wobei P der berechnete Neigungswinkel ist. 

Das Rollen (R) wird im Schritt 126 berechnet entsprechend dem 
Arkustangens von YI/ZI (Arkustangens (Hy 3 - Hy,)/(Hz 3 - Hz,)), und 
wird korrigiert im wahlweisen Schritt 128, der die Quadrant- 
Korrektur entsprechend dem Schritt 122 umfafct, die am berech- 
neten Rollenwinkel angewendet wird. 

Der Azimut wird im Schritt 130 berechnet, entsprechend dem Arku- 
stangens der anfanglich gemessenen Werte von Ye/Ze (Arkustangens 
Hy x /Hx { ) . Die Quadrant-Korrektur wird im wahlweisen Schritt 132 
angewendet, der den Vorgang vom vorstehend diskutierten Schritt 
122 umfaftt und am berechneten Azimutwinkel angewendet wird. 

SchlieBlich werden im Schritt 134 die berechneten Kurs- , Nei- 
gungs- und Rollwerte zu den externen Vorr ichtungen Oder dem Dis- 
play 7 4 ubertragen, wbraufhin das erf indungsgemaJie Verfahren zur 
Bestimmung von Azimut, Neigung und Rollen wieder mit Schritt 102 
beginnt. 


Ansprtiche 

Verfahren zur Bestimmung von Azimut und Neigung relativ zu 
einem Mefirahmen mit ersten, zweiten und dritten zueinander 
orthogonalen Achsen einer Struktur, die einen darauf karda- 
nisch aufgehangten KompaB enthalt , gekennzeichnet durch 
folgende Schrifte: Messen des Umgebungsmagnetf eldes in Form 
dreier im wesentlichen unabhangiger Komponenten und Liefern 
bzw. Erzeugen von Feldkomponentensignalen Xe, Ye und Ze, 
jeweils entlang zueinander orthogonaler X-, Y- und Z-Achsen 
in einem durch den KompaS definierten MeBrahmen (Block 
106); Anlegen eines ersten - zur Y-Achse des MeBrahmens or- 
thogonalen - vorgegebenen Magnetfeldes (Block 112); Messen 
der unabhangigen Komponenten des Magnetfeldes, die aus der 
Uberlagerung des Umgebungsmagnetf eldes und des ersten vor- 
gegebenen Magnetfeldes resultieren und Erzeugen von Feld- 
komponentensignalen Xp, Yp und Zp (Block 114); Bestimmen 
des Azimuts (9) entsprechend den, Arkustangens von (Ye/Xe) 
(Block 130); Bestimmen der Neigung (P) entsprechend dem 
Arkustangens von [ (Xp-Xe) / ( Zp-Ze) ] (Block 118 , 120) ; und 
Ubertragen von Signalen, die Azimut und Neigung darstellen 
(Block 134) . 

Verfahren nach Anspruch 1, gekennzeichnet durch folgende 
Schritte: Entfernen des ersten vorgegebenen Magnetfeldes 
und Anlegen eines zweiten - zur Richtung des ersten vor- 
gegebenen Magnetfeldes orthogonalen - vorgegebenen Magnet- 
feldes (Block 112) ; Messen der unabhangigen Komponenten des 
Magnetfeldes, die aus der Uberlagerung des Umgebungsf eldes 
und des zweiten vorgebenen Magnetfeldes resultieren und 
Erzeugen von Feldkomponentensignalen Xr, Yr und Zr (Block 
110); Bestimmen des Rollens (R) entsprechend dem Arkustan- 
gens von ((Yr-Ye)/[Zr-Ze) (i + sin P) ] } (Block 116# 124# 

126); und Ubertragen der das Rollen darstellenden Signale 
(Block 134) . 


Verfahren zur Bestimmung von Azimut und Rollen relativ zu 
einem Meftrahmen mit ersten, zweiten und dritten zueinander 
orthogonalen Achsen einer Struktur, die einen darauf karda- 
nisch aufgehangten KompaB enthalt, gekennzeichnet durch 
folgende Schritte: Messen des Umgebungsmagnetf eldes in Form 
dreier im wesentlichen unabhangiger Komponenten und Erzeu- 
gen von Feldkomponentensignalen Xe, Ye und Ze, jeweils 
entlang zueinander orthogonaler X-, Y- und Z-Achsen in dem 
durch den KompaB def inierten Meftrahmen (Block 106) ; Anlegen 
eines zur X-Achse des Mefirahmens orthogonalen vorgegebenen 
Magnetfeldes (Block 108) ; Messen der unabhangigen Komponen- 
ten des Magnetfeldes, die aus der Uber lagerung des Umge- 
bungsfeldes und des vorgegebenen Magnetfeldes resultieren 
und Erzeugen von Feldkomponentensignalen Xr, Yr und Zr 
(Block 110) ; Bestimmen des Azimuts (0) entsprechend dem 
Arkustangens von (Ye/Xe) (Block 130) ; Bestimmen des Rollens 
(R) entsprechend dem Arkustangens von [ ( Yr-Ye) / ( Zr-Ze) ] 
(Block 116, 126); und Ubertragen der Signale, die Azimut 
und Rollen darstellen (Block 134). 

Vorrichtung zur Bestimmung von Azimut und Neigung einer 
Struktur entsprechend dem Verfahren von Anspruch 1, gekenn- 
zeichnet durch ein in der Struktur enthaltenes Magnetometer 
(52, 60, 62, 64) mit drei zueinander orthogonalen Fuhlern, 
die den Meftrahmen definieren, der die X-, Y- und Z-Achsen 
umfaBt, wobei das Magnetometer in Bezug auf die Struktur 
uber die X-Achse in Rollrichtung und die Y-Achse in Nei- 
gungsrichtung beweglich ist und die Ausgangssignale Xe, Ye 
und Ze liefert, die die orthogonalen Komponenten des Umge- 
bungsmagnetf eldes im MeBrahmen darstellen; Mittel (54) zum 
Anlegen eines ersten - zur Y-Achse des MeBrahmens orthogo- 
nalen - im wesentlichen gleichf ormigen Magnetfeldes am 
Magnetometer aufgrund eines ersten Steuersignals (68) , 
wobei das Magnetometer Signale Xp, Yp und Zp liefert, die 
die orthogonalen Komponenten der Uberlagerung des Umge- 
bungsfeldes und des ersten homogenen Magnetfeldes im MeB- 
rahmen darstellen; Mittel (66) zur Bestimmung der Neigung 


der Struktur in Bezug auf das Magnetometer entsprechend dem 
Arkustangens [ (Xp-Xe) / ( Zp-Ze)] ; Mittel (66) zur Bestimmung 
des Azimuts der Struktur entsprechend dem Arkustangens von 
(Ye/Xe) ; und Ausgangs- bzw Ausgabemittel zur Lieferung von 
Ausgangssignalen, die den bestimmten Neigung und Azimut 
(72) entsprechen. 

Vorrichtung nach Anspruch 4, gekennzeichnet durch Mittel 
(56) zur Erzeugung eines zeiten - zum ersten im wesentli- 
chen homogenen Magnetfeides orthogonalen - im wesentlichen 
homogenen Magnetfeides am Magnetometer (52, 60, 62, 64) 
aufgrund eines zweiten Steuersignals (70) , wobei das Magne- 
tometer Magnetometer-Ausgangssignale Xr, Yr und Zr liefert 
die orthogonale Komponenten der Uberlagerung des Umgebungs- 
feldes und des zweiten homogenen Magnetfeides im MeBrahmen 
darstellen; und durch Mittel (66) zur Bestimmung des Pol- 
lens der Struktur gemafl dem Arkustangens von {(Yr-Ye)/ 
t(Zr-Ze) (i + sin P) ] > , wobei die Ausgangs- bzw. Ausgabe- 
mittel au/Jerdem ein Ausgangssignal liefern, das dem be- 
stimmten Rollen entspricht (72) . 

Vorrichtung 2U r Bestimmung von Azimut und Rollen einer 
Struktur in einem Umgebungsmagnetf eld entsprechend dem 
Verfahren von Anspruch 3, gekennzeichnet durch ein in der 
Struktur enthaltenes Magnetometer (52, 60, 62, 64) mit drei 
zuemander orthogonalen Fuhlern, die einen MeBrahmen defi- 
meren, der die X-, Y- und Z-Achsen umfafit, wobei das Ma- 
gnetometer in Bezug auf die Struktur iiber die X-Achse in 
Rollrichtung und die Y-Achse in Neigungsrichtung beweglich 
ist und die Ausgangssignale Xe, Ye und Ze liefert, die die 
orthogonalen Komponenten des Umgebungsmagnetf eldes im MeB- 
rahmen darstellen; Mittel (56) zur Erzeugung eines - im we- 
sentlichen zur X-Achse des Meflrahmens orthogonalen - im we- 
sentlichen gleichformigen Magnetfeides am Magnetometer 
aufgrund eines Steuersignals (70), wobei das Magnetometer 
die Ausgangssignale Xr, Yr und Zr liefert, die die orthogo- 
nalen Komponenten der Uberlagerung des Umgebungsf eldes und 
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des im wesentlichen gleichf ormigen Magnetf eldes im Meflrah- 
men darstellen; Mittel (66) zur Bestimmung des Rollens der 
Struktur gemaG dem Arkustangens von [ (Yr-Ye) / (Zr-Ze) ] / 
Mittel (66) zur Best immung von Azimut der Struktur gema/3 
dem Arkustangens von (Ye/Xe) ; und Ausgangsmittel zur Liefe- 
rung von Ausgangssignalen, die den bestimmten Rollen und A- 
zimut entsprechen (72) . 
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